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Given a set of origin-destination points in the plane and a set of polygonal barriers to 
travel, this paper develops an efficient algorithm for finding minimal distance feasible 
paths between the points, assuming that all travel occurs according to the rectilinear 
distance metric. By geometrical arguments the problem is reduced to a finite network 
problem. The nodes are the origin-destination points and the barrier vertices. The 
links designate those node pairs that ‘‘communicate” in a simple way, where com- 
munication implies the existence of a node-to-node rectilinear path that is not made 
longer by the barriers. The weight of each link is the rectilinear distance between its 
two corresponding nodes. Solution of the minimal distance path problem on the net- 
work procedes in two steps. First, for a given origin or root node, a tree is generated 
containing a minimal distance path to each node that communicates with the root 
node. Second, a modified Dijkstra-type iteration is utilized, starting with the nodes 
of the tree, sequentially adding nodes according to minimum “penalty distance,” 
where the penalty is the extra travel distance caused by the barriers. The paper con- 
cludes with a discussion of the computational complexity of the procedure, followed 
by a numerical example. 


{. INTRODUCTION 


The rectilinear distance between two points (x1, 1), ¢2,¥2) is 1x1 - Xal + 1y1- Val. 
This distance is sometimes called right-angle, L,, or Manhattan distance. This paper 
develops an algorithm for finding minimum rectilinear distance paths between given 
origin-destination points, in the presence of polygonal barriers to travel. The barriers 
need have no special properties, such as convexity. 

The problem arises in a number of areas: 


(1) Urban transportation. Urban vehicles travelling on a street grid may be consid- 
ered to be governed by the right angle metric. Barriers to travel could include ceme- 
teries, parks, railroad yards, rivers, etc. Effective operation of these systems would 
require knowledge of “best paths” around such barriers. (Ironically, the motivation 
for this paper originated with transportation work by these authors in Manhattan, 
which revealed the inadequacy of the “Manhattan distance metric’ as a measure of 
travel distance between two points due, primarily, to New York’s Central Park.) 

(2) Plant and facility layout. Travel on a plant or factory floor can often be mod- 
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eled as right-angle. Barriers to travel would be impassable areas on the floor, such as 
sub assembly areas, shops, sections of assembly lines, etc. The algorithm proposed 
here not only could reveal optimal paths between points, but also could be used to 
examine the plant floor travel-time consequences of alternative floor layouts. 

(3) Locating power lines. In sections of the midwest of the U.S. new power lines 
are only allowed to be located along the east-west or north-south boundaries between 
surveyed mile-square or quarter-mile square sections. The location of such a power 
line occurs, then, along a right-angle route. Barriers in this problem could include 
towns, highways, parks, or subsections otherwise not available for power line routing. 


Other potential applications include design of printed circuit boards, certain cutting 
problems, and finding the path through a maze (perhaps for a robot). 

In the literature there has been some work on related problems. A discretized version 
of our problem, in which both the barriers and the feasible travel region are assumed 
to be elements of a finite rectangular grid, has been considered by Damm [1]; in the 
discrete case, the network nodes are automatically constrained to be integer lattice 
points (not in the barriers), and thus the network structure and its properties are 
relatively straightforward. We are aware of no other work on the exact problem ex- 
amined herein, allowing arbitrarily complex polygonal barriers and L, paths anywhere 
except in the barriers. The closest nondiscretized work pertains to the analogous 
problem using the Euclidean metric. In 1974 Wangdahl, Pollack, and Woodward [2] 
developed a procedure for finding the minimal distance path between two points in 
the presence of polygonal barriers, where each path step utilizes the Euclidean metric. 
The node set N consists of the origin and destination points and the vertices of the 
barriers; each finite length link joins a node pair for which a connecting straight line 
can be drawn between the nodes without intersecting any barriers. The proposed 
“visibility algorithm’ (so named because connecting nodes could “‘see each other”’) 
utilizes a variant of dynamic programming, which essentially is Dijkstra’s algorithm 
[3]. Independently in 1974, Vaccaro [4] solved a similar problem, but only for 
barriers represented by line segments. The Wangdahl et al. procedure appears to 
have been rediscovered in 1978 by Lozano-Perez and Wesley [5S], who offer their 
“VGRAPH” procedure only for convex polygons. Very different applications 
motivated each of these three efforts: minimum trajectory pipe routing through a 
ship [Wangdahl et al.], routing urban vehicles [Vaccaro], navigating an early robot 
vehicle named SHAKEY [Lozano-Perez and Wesley |. 

The paper proceeds in three parts. In Sec. II we summarize results necessary to 
transform the problem in the x-y plane, with a noncountably infinite number of 
paths, to a finite network problem. In Sec. III we develop the details of the algorithm, 
POLYPATH, and discuss its computational complexity. In Sec. IV we present a 
numerical example. 


il. TRANSFORMING TO A NETWORK PROBLEM 
A. Preliminaries 


We consider Euclidean 2-space R?. Within R? there are Ng origin-destination points 


Q= {q(i), i= 1,2,...,ng} 
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and ”g polygonal barriers B,,(m = 1,2, ..., 2g) with vertices 
V = {o(k,m),k=1,2,...,0,;m=1,2,...,ng}, 


where v(k, m) is the kth clockwise-ordered vertex of barrier m and v,, <© is the 
number of its vertices. The coordinates of g(i) are {x(i), y(i)} and the coordinates 
of u(k, m) are {x(k,m), y(k,m)}. B,,(m = 1,..., mg) is an open set, e.g., for convex 
barriers the intersection of v,, open half-planes. Hence, the vertices and sides of B,, 
are not contained within B,,. We assume (without loss of generality) that barriers do 
not intersect (i.e., B,, OB, = © = null set, forn #m). 

A rectilinear path P in R? having 2(s + 1) steps is specified by a sequence of path 
vertices V(P) = {(xo, Yo), (1, Yo)s 1, V1)» Has V1), Ha, Va)s- «+ ss Ve)s Kear sIs)> 
(Xs41sYe+1)} = [{x}, {y}],s = 0, 1, Zs aye a9. such that 


P= {(x,¥_) ER X—p SX KX pay OC Xe, KX KS X,_, kK =0,1,..., 5} 


U {K,V) ERs Views SVS, Or, SY Sy_y, k= 1,2,. 21,84 Dy. 


That is, a path is a connected set of points proceeding in straight line segments hori- 
zontally from (x9, ¥o) to (%1, Yo), then vertically to (x1, y,), then horizontally to 
(%2,.1), etc. To allow the first step to be vertical, simply set x, =x 9. In our develop- 
ment we consider the merged set of points W=QUV. A path Py from w(i) € W to 
w(/)€ W is specified by a set of path vertices originating at (x9, ¥o) = Xy(‘), YW) 
and terminating at (Xs41, Ysa1) =@w(/), Yw(/)). A feasible path P,; from w(i) to 
w(/) penetrates no barriers, hence satisfies the condition Pj, N furs Byl=o. We 
assume the existence of at least one feasible path between each pair w(i), w(/). The 
rectilinear length (or simply length) of path P is 


L(P)=L,(P) + Ly), 


where 


LP)= 


Ss 
k=0 


Ss 
[Xxar ~ Xxl and Ly(P)= 5° (yeas ~ Ved. 
k=0 


The minimum rectilinear travel distance between two points (x, y) and (x’, y’) is 
t([x,¥], [x’, y’]), obtained by following a shortest length feasible path between the 
points. 

The problem is as follows: For any given origin q(i) find a minimal length feasible 
path and the corresponding travel distance to each possible destination q(j). Repeated 
application over i of any solution algorithm yields minimal length feasible paths be- 
tween all origin-destination pairs. 

Two points wi)EW, w(j/)EW, having coordinates yi), Yw@) and &,,(/), 
Yw(/)), are said to communicate if there exists at least one feasible path Py between 
them having length L(P;;) = |Ixw(/) - x, @I + lyw) - Vw) = cj. That is, two points 
communicate if the barriers cause no net increase in travel distance between them. 
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The minimal feasible travel distance between w(i) and w(/) is abbreviated ¢(i, J) [= 
tw), wl, bw). ywADI- 

A path P having path vertices V(P) = {(%o, Yo), (%1,Yo)s- - +> &s415H541)} is a Stair- 
case path having staircase vertices if {x,,k =0,1,...,s+1} and {y,,k=0,1,..., 
s+1} each form monotone sequences, i.e., if sgn (Xx4, - X_) = Sgn (XR ~ X~-1) and 
sen (View - Ye) = S80 (Ve - Ven1),K =1,2,...,8. [sign (0) is arbitrary]. 

We now state three elementary observations: 


(1) Two points having coordinates (x9, Yo) and (%541, ¥s+1) communicate if and 
only if there exists at least one feasible staircase path between them. 

(2) Any path having minimal length joining two communicating points must be a 
staircase path. 

(3) Any two points, joined by a straight line segment that has no points in com- 
mon with any barrier, communicate. Thus, all pairs of adjacent vertices of a 
barrier communicate. 


The third observation can be proved by constructing a staircase path along the straight 
line connecting the two points, keeping the path sufficiently close to the line so that 
no path step intersects a barrier (see Fig. 1). (In certain situations, as illustrated later 
in Figure 3(e), this procedure may require a countably infinite number of steps.) 


B. Vertex-Seeking Tree 


We now wish to construct a simple tree about each node which provides a basis for 
path formation. First consider a point q(i) € Q having coordinates {x(i), y(i)}. We 
wish to construct the “positive x probe” r,+(q(i)) from q(i). To do this, extend a ray 
from (x(i), y@) horizontally in the direction of increasing x. There are three possibil- 
ities (see Fig. 2): 


(1) The ray intersects no barriers, in which case r,+(q(i)) = (x,y) ER?: y = yd), 
x > x(i))}, ie.,7,6(@(@) is the ray. 

(2) The ray intersects another point w(j) € W (either a barrier vertex or an origin- 
destination point), in which case r,+(q(i)) = {(%,y) ER?: y =v), xO <x < 
Xw(/)}; ie., 7,+(q (A) is the line segment connecting q(i) and w(/). 

(3) The ray intersects side kK of a barrier m, the point of intersection being a. 
The barrier side is thereby partitioned into two subsides having endpoints 


NG TWO 
ADJACENT VERTICES 
OF A BARRIER 


FIG, 1. Illustration of staircase path between two adjacent vertices of a barrier. 
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(a) RAY INTERSECTS NO BARRIERS 


BARRIER VERTEX 
(x(i), y(i)) a 


a-—- ANOTHER 
: ; ORIGIN - DESTINATION 
(x(i), yi) INT 


(b) RAY INTERSECTS ANOTHER POINT 


v(k,m) 
eee 
(x(i), yi) 
v(k+I,m) 


RIGHT ANGLE. ¥‘K»m) 
™e 


(xi), y (i) 
v(k+l,m) 
(c) RAY INTERSECTS A BARRIER SIDE 


KEY: @—»—»—*s—+ = rx, (qli))= POSITIVE x PROBE 
(x(i), yi) 


FIG. 2. The positive x probe: examples. 


(v(k, m), a) and (@, v(k + 1, m)). Here r,.(q(i)) is the union of the line seg- 
ment from q(i) to a and that subside which lies at an obtuse angle to the 
segment from q(i) to a. (In the case of right angle intersection r,+(q(i)) need 
not have this second component.) 


In a like manner we can construct probes r,»(q(i)), 7,-(@(@)), and 7,,-(q(i)) in the 
positive y direction, negative y direction, and negative x direction, respectively. The 
vertex-seeking tree about the root node q(i) is 


VST @(@)) = re@@) Yr,-@@) Yry@@) Yry-@@). 


By construction of the tree, it is clear that all points on the tree communicate with 
qi). 

Now consider a barrier vertex u(k,m)€V. A similar vertex-seeking tree is con- 
structed for u(k, m), with the obvious condition that no point in the tree can pene- 
trate barrier m. Thus, depending on the orientation of the barrier about u(k, m), the 
number of feasible probes about v(k, m) may be 4, 3, 2, 1, or even 0. (See Fig. 3.) 
We now state a fourth elementary observation: 


(4) Suppose for two points w(i) € W and w(/) € W, an x-probe from one and a 
y-probe from the other share at least one common point b. Then w(i) and 
w(j) communicate. 
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v(k,m) 
{a} FOUR PROBES POSSIBLE (ob) THREE PROBES POSSIBLE 
(c) TWO PROBES POSSIBLE {d) ONE PROBE POSSIBLE 


(e) ZERO PROBES POSSIBLE 


FIG. 3. Possible vertex-seeking trees from a barrier vertex. 


We have now identified three conditions under which two vertices w(i) and w(/) 
communicate: 


(1) If w@) and w(/) are adjacent vertices of a barrier. 
(2) If w(Z) is the root and w(/) is a terminal point of a vertex-seeking tree. 
(3) If w(i) and w(7) have x and y probes that share at least one common point b. 


A pair of vertices w(i) and w(/) is called simply communicating if it satisfies at least 
one of these three conditions, assuming with condition (3) that there exists a point of 
commonality b ¢W (otherwise each vertex communicates simply with b, but only 
communicates with the other vertex). 


C. Vertex Following Paths 


Theorem 1. Suppose two points w(t) € W, w(j) © W communicate, but do not com- 
municate simply. Then there exists at least one feasible staircase path Pi between 
them containing a sequence of simply communicating vertices {w(), w(k?),..., 
w(kn), w(/)}. 


Proof: Consider the case x,,(/) = x), ¥w(/) = yw). We demonstrate the exis- 
tence of w(kf'), with the remaining w(kj‘) obtained by induction. Since w(i) and 
w(/) communicate, there exists at least one feasible staircase path Py between them, 
with path vertices VP ij) = {&wli) =Xo, Vwi) =Yo), @, > Yo); (1, yi), ere) (xs, Ys), 
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(wd) =Xs01, Ys), Heer, Vw) =Vear)}, such that xp4, > XK, Ver > Valk =O, 1, 
.. +58), and LPy) = (7) - xwW@)) + wW) - yw). 

Now construct an alternate equal length feasible staircase path from w({i) to w(/). 
Beginning at x =x, create a new path step [(x, vo), (x, )] and push it as far as to 
the right as possible up to and including x,. If x, is reached without intersecting a 
barrier, continue to push rightward with the amalgamated path step [(x, Yo), , y2)]. 
Eventually there must be an amalgamated path step [(x, yo), (x, ¥;,)] that intersects a 
barrier vertex or a barrier side for some x =x, x, <x} <Xx4,. If not, then x could 
reach x,,(/), implying that w(i) and w(/) communicate simply, a contradiction. 


Case 1. Ifthe intersection is with a barrier vertex v(k, m) = {x(k, m), y(k, m)}, we have 
x(k, m)= x‘, and y(k, m) > y,,(i). Since r,+(w(i)) obviously intersects ry-(v(k, m)), 
v(k, m)= w(k?). 


If the intersection is not with a barrier vertex, it must be with a barrier side. In 
this case, continue the step pushing and amalgamation process, with the intercepted 
barrier side being the step’s lower end point. 


Case 2. We may reach an endpoint or vertex v'(k, m) of the barrier side, in which case 
the new path from w(i) to v'(k, m) has reproduced r,+(w(#)) and thus v'(k, m) = w(k?); 
or 


Case 3. We reach a point x} at which the amalgamated step intercepts a barrier vertex 
v"(k, m); in this case r«(w(4)) O r,-(v"(k, m)) # @, and thus v"(k, m) = (kf). 
One continues by induction, eventually reaching w(j). = (See Fig. 4.) 


Suppose two points w(i) € W, w(j) © W do not communicate. Consider a minimal 
distance path P;; between w(i) and w(/), ie., L(Pj;) < Lj) for all feasible Py. The 


FIRST 
AMALGAMATED 
PATH STEP 


INITIAL PATH PUSH 


Aiiiitiitélé =| QCUS OF STEP’S 
LOWER END POINTS 


FIG. 4. Illustration of the path push and amalgamation process. 
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Ay TURNING STEP 


DIRECTION 
OF TURN 


DIRECTION 
OF TURN 


AN x TURNING STEP 


FIG. 5. X and Y turning steps. 


path vertices are V(P1;) = {(xw) = Xo, Yw) = Yo), G1, Yo), (1, 1), +» Os, Ys), 
(xw7) = Xs415 Ys)» Ose1,YwO) =Ys41)}. Since w(i) and w(j) do not communicate 
L(Pij) > Ixwl) - xwU/)I + lyw@) - yw). Hence there exists at least one point 
x, € {x ,} such that sgn (x, - xx~-3) # sgn (pay - Xx) Or Ye © {yj} such that 
sgn (Ve - Ye-1) #880 (Yx41 ~ Ye). For any such x, the path step ((cx, Yx-1), x, e)I 
is called an x turning step. And for any such y, the path step [(xx¢, x), &xka1,Yx)] is 
called a y turning step (Fig. 5). 
We now state without proof the following: 


Lemma. All turning steps in a minimal distance path intersect a barrier vertex, with 
the barrier situated in the direction of the turn. 


We now complete our geometrical arguments with 


Theorem 2. Suppose two points w(i)€ W, w(j) €W do not communicate. Then 
there exists at least one minimal distance feasible path Pj between them containing a 
sequence of simply communicating vertices {w(i), w(kT), w(kKf), ...,w(kz), w(/)}- 


Proof: From the Lemma all turning steps in a minimal distance path P,; contain a 
barrier vertex. But by the definition of turning steps, the {x,} and {y,} between two 
successive turning steps form monotone sequences, i.e., staircase subpaths. By Theo- 
rem 1 for each staircase subpath we can construct at least one feasible alternative stair- 
case subpath containing a sequence of simply communicating vertices, beginning at 
one turning step barrier vertex and ending at the next one. In this manner we can 
construct the desired minimal distance path Pj. a 


(1. THE MINIMAL DISTANCE ALGORITHM: POLYPATH 


Our results demonstrate that any minimal distance path in R? can be replaced by an 
equidistance path containing a sequence of simply communicating vertices. Thus the 
problem of finding a minimal distance rectilinear path between q(i) and q(/), in the 
presence of polygonal barriers, can be reduced to a finite network problem. The net- 
work nodes are the origin-destination points q(i) and the polygon vertices u(k, m). 
The arcs are bidirectional, having weights corresponding to the distances between 
simply communicating vertices. 
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The algorithm, called POLYPATH, contains three major steps: 


1. Generation of the network. 
2. Identification of all vertices communicating with a root vertex. 
3. Finding the minimal distance path. 


We consider each step next. 


A. Generating the Network 


The network for our problem is G(W, L), where W= Q U V is the set of mw nodes or 
vertices and L is the set of links. Let S = set of simply communicating vertex pairs. 
For any {w(i), w(/)} € S, the length of the link /(i, 7) € L is d;; = |x,,(i) - xy (i+ 
lywG)- Yw(/)l. For any {w), w(/)} €S, dy =+e° [or, equivalently, link /(, /) 
does not exist]. The matrix of link lengths is D = (dj). As above, we let ¢(i,/) be the 
length of a minimal distance path between nodes w(i) and w(/). Given the problem 
statement, we know that the network is connected, i.e., that there exists at least one 
path between each pair of vertices. 

Construction of the set S is straightforward. A vertex pair {w(i), w(/)} is included 
in S if and only if (1) w(i) and w(/) are adjacent vertices of a barrier; or (2) w(i) 
and w(/) are contained in the same vertex seeking tree, with either w(i) or w(/) being 
the root vertex of the tree; or (3) w(i) and w(/) have x and y probes that intersect 
at a point other than a vertex w(k). Generation of the vertex-seeking tree involves 
only tests for straight line intersection and, for obtuse angle checks, inequality tests. 
Similarly, checks for intersection of x and y probes involve only intersection tests. 

A network minimal distance path between two points is called an optimal nodal 
path. It should be clear that traversal of any network link /(i, j) corresponds to x-y 
travel along any one of a (usually) noncountably infinite number of staircase paths 
between the two simply communicating nodes w(i) and w(j). Thus, specifying a 
path on the network corresponds to specifying a unique sequence of nodes to visit 
but a nonunique path in R?. 

The number of optimal nodal paths between two origin-destination points can be 
large. Recalling the proof of Theorem 1, by pushing the path upward rather than 
downward we would have proven the existence of another optimal nodal path be- 
tween two nonsimply communicating nodes w(i) and w(/). Thus, any two nonsim- 
ply communicating nodes have at least two (and possibly more) optimal nodal paths 
connecting them. Two noncommunicating nodes connected by an optimal nodal 
path with m turning steps typically have a total of 2”*! or more different optimal 
nodal paths connecting them. (The number may be less than 2”*! only when nodes at 
adjacent turning steps in an optimal nodal path communicate simply.) 


B. Vertices Communicating with w(/) 


In applications, typically many vertices (perhaps the great majority) communicate, 
though not simply. Thus it is beneficial to find a procedure for quickly identifying 
communicating vertices. 

Consider w(i) to be the root vertex. We wish to construct a tree F(w@)) C G(W, L) 
containing all nodes communicating with w({i). F(w(i)) is usually not unique because 
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of the possibility of multiple minimal distance paths; our construction will produce a 
tree F(w(i)) having a minimal number of nodes in the tree path from the root w(i) to 
any w(j) © F(w(@)). 

To generate F(w(i)), we define eight ‘‘orientations” or “directions of travel” from 
w(i), as indicated in Figure 6(a). We define the node orientation matrix ® = (¢,,), 
where 


$4; = orientation of node w(/) with respect to node w(i)(¢j = 1, 2,..., 8). 


For instance, if ¢;;=4, then node w(j) is northwest of node w(i); w(j) and w(Z) 
need not communicate. For computer storage purposes, it is useful to note that 
Oj = Gy + 3)mods t 1. 

For each pair of communicating nodes w(i) and w(/) having orientation $j; we de- 
fine a permissable direction set Tj) such that 


I'(¢;;) = set of orientations about node w(/) that may 
include staircase paths through w(/) to w(Z). 


For instance, (2) = {1, 2, 3}, meaning that any vertex w(/) northeast of a root vertex 
w(i) may have staircase paths from directions 1,2, or 3 passing through it to the root 
vertex. The sets P'(@,;) are P(1) = {1, 2, 3,7, 8}, F(2) = {1, 2, 3}, PG) = {1, 2,3,4, 5}, 
T(4) = {3, 4, 5}, P(5) = {3, 4, 5, 6, 7}, 26) = {5, 6, 7}, 1(7) = {5, 6, 7, 8, 1}, F(8) = 
{7,8, 1}. (See Fig. 6(b) and 6(c)). 

We say that w(/) n-communicates with w(i) if the minimal number of nodes in 
all optimal nodal paths from w(i) to w(j) is n+ 1, n=0, 1,...,mw-1. wi) 
O-communicates with itself. For some node w(/) that n-communicates with w(i), 
link 1(k, 7) is a predecessor link for w(/) if 1(k, /) is on the algorithm-selected (n + 1)- 
node optimal path from w(i) to w(j/). For any such /(k,/), w(K) must (n - 1)- 
communicate with w(i) and ox; © (jx). 

We construct the tree F(w(i)) by iteratively obtaining the sets of vertices that 
n-communicate with w(i), together with the corresponding predecessor node for each 
vertex, for n first equaling 1, then 2, 3, etc. The necessary node-link sets are 


A, (wi) = (ww), L&, 7) € GW, L): wk) (2 - 1)-communicates with 
w(i), dx; < ee, bxj = Tix} n= 12; 3, -++,Rp.- 


As the boundary condition, we say that Ag(w(i)) contains only w() with no prede- 
cessor link, i.e., Ag(w(i)) = {((w@), ¢)]. Clearly, 


Fou) = J Ano). 


It is noted that some of the A,(w{i)) may be empty, and that A,(w@)) = ¢ implies 
that A,.,(w(i)) = ¢. The iterative tree generation algorithm is as follows: 
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! EIGHT POSSIBLE 
ORIENTATIONS ABOUT 

THE ORIGIN, GIVEN IN 
COUNTERCLOCKWISE ORDER 


(a) EIGHT POSSIBLE ORIENTATIONS 


ORIENTATION OF w(j) ORIENTATION OF w(j) 
WITH RESPECT TO wii) WITH RESPECT TO w(i) 
1)=41,2,3,7, 
P(2)={1,2,3} / rt) { 8} 
(i) : j 
ey ORIENTATIONS 
ABOUT w(j) 


THAT MAY INCLUDE 
STAIRCASE PATHS 
THROUGH w(j) TO w(i) 


(b) w(j) SITUATED (c) w(j) SITUATED 
NORTHEAST OF w(i) EAST OF wii) 


FIG. 6. Orientations and permissible direction sets. 


Algorithm Af: Tree Generation 


Step 1: n=0, Ao(w@)) = {(W@), o)}; AnW@) = (@, O)},2* 1,2,..., ny. 

Step 2: For each w(k) € A,(w(i)), scan the kth rows of and D to find all links 
i(k, 7) such that dy; << and ¢; © T'(¢;,). For each such link /(K, /), if its termi- 
nal node w(/) € UF, ag Am(w(i)), then 


Ans (WO) Ans W@)Y (W), 1K, /}- 


Step 3: n«nt1 
Step 4: lfn=ny - 1 or if A,(w@) = {@, ¢)}, Stop. Else go to Step 2. 
The fact that the minimal distance path from w(i) to any node on the tree F(w(i)) 
contains a minimal number of links may be useful in applications. 

Clearly for any w(/)€ F(wf)), G7) = lxw® - rw) + lyw® - yw). This 
computation could also be carried out in the above algorithm by setting t(i, 7) = 0 in 
Step 1 and adding the computation ¢(i, 7) = t(i, k) + d,; at the end of Step 2. 


C. Finding All Minimal Distance Paths 


We now develop an iterative procedure for finding the- minimal distances and corre- 
sponding minimal distance paths from a root node w(?) to all other nodes w(/). The 
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procedure is analogous to Dijkstra-type [3] iterations for finding minimal distance 
paths on a network, except that we begin with the tree F(w(i)) and focus on penalty 
travel distances, not absolute travel distances. Here, the penalty distance associated 
with an optimal path from w(/) to w(Z) is 


eG A)=tG1)- (ewO- xwI+ lyw® - ywDI- 


The penalty e(i,j) represents the net increase in travel distance due to the presence 
of the barriers. Note that a minimal distance path corresponds to a minimal penalty 
path. Clearly for two nodes w(i) and w(/) that communicate, e(i, /) =0. 

Suppose we arrange the nodes in order of their penalty distances e(i,/), using the 
index a, = identification number of the node that has the mth smallest e(i,/). If 
F(w(i)) contains e nodes, then the ordering of the first e nodes is arbitrary since 
their penalty terms are all 0. For any m2e, partition the nodes {w(i) € W} into 
two sets: 


The “closed” nodes: Ay, (ilm)= {w(/) ©W:7 € [a,,02,...,0,]} 
The “open” nodes: H,(i|m)=W- A,(ilm) 


H,(ilm) is the set of m least penalty nodes for w(Z). 

Consider all the open nodes that communicate simply with at least one closed node, 
ie., H(ilm) = {w(/) € Hy (ilm): dg, <+, n=1,2,...,m}. For any open node 
w(j)€ H;(ilm) define its m-stage estimated penalty distance for a trip to w(i) to be 


é(i, jlm)= MIN [dans + ti, &)] 


n€[1,...,m]idqj<+ 


~ (xw) - xw(I + yw - yw(A)D. 


Here @(i, j|m) is our current “‘best guess” of the true penalty e(Z, j|m), given the iden- 
tity of the m least penalty nodes. The best guess is generated by attaching each node 
in H3(ilm) directly through. one link to a node in H,(ilm) in a way which minimizes 
the total penalty. 


Theroem 3. For any given m=1,2,...,ny, the m+ Ist least penalty node is one 
with minimal estimated penalty distance, and its penalty distance is this estimate, i.e., 


€(7, Om +1) = MIN [@G, flm)] = €o 
j:w({)EH (im) 


and 0,4; is anode w(j)€H4(i|m) that achieves the minimum. (Ties can be broken 
arbitrarily). 


Proof: 1. Suppose e(i, @41) > €o. Then closed node (a,,,,) could be replaced by 
an open node w(/) that achieves the minimum, resulting in a penalty smaller than 
€(7, G41), a contradiction. 
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2. Suppose €(i,O44;)<€o. Then there exists some open node w(j”") € H3(ilm) 
having penalty smaller than the indicated minimum. We need consider only w(j”) € 
H}(ilm) since a minimal distance path from any w(j”)€A2(ilm) - H,(ilm) must 
pass through an open node simply communicating with a closed node in H;, (ilm), 
incurring a penalty not less than that of the simply communicating node. But for any 
w(j")€H3(ilm), a decrease in penalty from that node associated with €9 requires a 
new multilink path from w(j") eventually to some node in H,(i)m). The penalty of 
any such path cannot be less than the penalty of the penultimate node in the path, 
which itself is contained in H,(i\m). And this penalty cannot be less than € 9, the 
indicated minimum. We have reached a contradiction, and the theorem is proved. & 

We now have all the results necessary to find the minimal distance paths from any 
root vertex w(i) to all other vertices w(/). Basically, after identifying all nodes that 
communicate with w(i), we add one node at a time to the tree of our least-penalty 
nodes. This is a Dijkstra-type iteration performed on first differences rather than mag- 
nitudes of travel distances. The tree containing the m least penalty nodes for w(Z) is 
fully specified by 


(ilm) = set of pairs of nodes and predecessor links in the 
tree of m least penalty nodes for w(i) 


We now detail 


Algorithm A2: Finding Minimum Penalty Nodes 
Step 1: Initialization . 
For all e w(j) € F(w@)), e(i,) = 0, @, 7) = lxw® - ew + yw - yw). 
Assign each a;,i=1,2,...,e, to a unique vertex having e(i, 7) = 0. 
m=e 
H,(ilm) = {w(i) € W: 7 € {01, 02,...,%m}}, 
H,(i\m) =Ww- A, (ilm), 


From Al, y(ilm) = U An(w@)). 


n=0 
Step 2: First Iteration, For all w(j) © H, (il|m), compute 
é(i, j|m) =MIN {2, MIN [dani + t(i,O)] - (xpi) - xw)I 


nE[1,...,m]:dg,j<+™ 


+lyw@ - Yw(A)D} 


Step 3: Subsequent Iterations 


Setes= MIN  [@(,/Im)] 
j:w(i)EH (im) 


Qn +1 = any vertex j(w(/) € H2(ilm)) having €(i, j]m) = éo. 

t(i, Om41) = €o + lXyW@) - Xwlmor)1 + l¥WwW@ - VwOm+1)I- 
The predecessor link 1(Q,, Qn41) in y(@ilm) is determined by that a,,, say a? , which 
yields the minimum €p. 


298 LARSON AND LI 


TABLE I. POLYPATH: Summary Description. 


Step 1: Network Formulation 
Network node set W=QU V. 
Construct set § of simply communicating vertex pairs: 
w(i), w(j) are included as a pair in S if 
(a) they are adjacent vertices of a barrier, 
(b) they are contained in the same vertex seeking tree, with one as a root vertex, 
(c) they have x and y probes that intersect at a point other than another vertex. 
For each {w(i), w(j)} €S, the length of link /(i, j) is 


dij = |xwi)- xwI + lywO - yw 


else dj; = +, 
Compute the node orientation matrix ® = ($y). 
Step 2: Find Vertices Communicating with w(i) 
Execute Algorithm Al: Tree Generation 
Step 3: Find Minimal Distance Paths to Remaining Vertices 
Execute Algorithm A2: Finding Minimum Penalty Nodes 
Repeat for all i,i= 1,2,...,n@, if entire matrix T = (t(, 7)) is desired. 


y(ilm + 1) = (lm) U {Wem +1), On, Umar)}, 
H, (ilm) = Hy (ilm) U Wma); 
H,(ilm) = H2(ilm) - wom +1), 
m<mt i, 


Step 4: New Estimated Penalties 
Compute 


€(i, jm) =MIN {€(, flm-1), MIN [dag + #@, Om) 


i:day, jst” 
~ (ew - xwAI + lyw® - yw()D} 
If H,(ilm) = @ then exit, else go to Step 3. 


Algorithm A2 completes the POLYPATH algorithm, a summary description of 
which is given in Table 1. 


D. Computational Complexity 


The computational complexity of the POLYPATH algorithm, once the network is 
constructed, is usually less than that of the Dijkstra algorithm. Recall that in our 
problem there are ng origin-destination points, > he Um barrier vertices, and 
Ny =Ng t UpPes Um nodes in the constructed network. 

Suppose our problem is to generate the entire (ng X ng) minimal travel distance 
matrix between all origin-destination pairs (q(i), q(/)). We do this by executing 
POLYPATH ng times, once for each possible origin point. [This ignores possible 
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exploitation of the symmetry of the matrix.] Each such execution is done on an 
nwy-node network, yielding nw minimal distances, and straightforward application of 
the Dijkstra “node labeling” procedure would require approximately (5/2) n¥ addi- 
tions and comparisons [6]. 

But in POLYPATH the tree generation algorithm Al can be executed with no addi- 
tions or comparisons, just simple storage manipulations (file creation), if the D and ® 
matrices are appropriately rearranged to allow easy tracing of trees through permis- 
sable directions. This is accomplished by grouping together all nodes that are direc- 
tion n from q(i), for each n=1,2,...,8, and using indirect addressing to retrieve 
these nodes. Using this technique, the computer can sequentially create the communi- 
cating tree of nodes (the zero penalty nodes) with essentially no marginal computa- 
tional effort, beyond the fixed one-time effort required to group nodes by direction. 

Suppose a fraction f of nodes in the complete n y-node network communicate. Then, 
Dijkstra-type iterations must be performed only on the (1- f) nw positive penalty 
nodes. (These iterations are performed only on the penalty distances, not absolute 
distances, but the computational work is the same.) The number of additions and 
comparisons required for each possible origin point is thus reduced to approximately 
(5/2) {1 - f) nw]*. The computational complexity associated with generating the entire 
(ng X ng) matrix (ignoring its symmetry) is thus approximately no S[ -f)ny]?. 
If f= 0.5, say, POLYPATH reduces the amount of computational work compared to 
Dijkstra, by 75%. 

T. Wong has programmed POLYPATH in PL/I [7]. He has solved problems of con- 
siderable complexity, including finding an optimal path from the center of a 27-node 
maze to the center of an 18-node maze. 


IV. EXAMPLE 


We now illustrate the algorithm with a simple two-barrier, six origin-destination 
point example, shown in Figure 7. This problem includes all of the different situations 
that can occur with a vertex-seeking tree: nodes with 0, 1, 2, 3, or 4 probes and probes 
terminating at another origin-destination point, at a barrier vertex, or intersecting a 
barrier side. We shall find the minimum rectilinear distance to all origin-destination 
points from point 1. 

The first step is the generation of the link length (D) and orientation (®) matrixes. 
(Table II). Each entry (i, j) of the matrix includes the pair dj; and $;;, where dj; is the 
link length from node i to node j and @j, is the orientation of 7 with respect toi. Any 
(i,j) for which dj; = + is left blank. Although this matrix generation involves tedious 
but simple inspections, it can be done efficiently by a computer. 

Using the D and ® matrixes, we invoke Algorithm A1 to generate the tree of vertices 
that communicate with node 1, i.e., F(w(1)) in our notation. It is noted that nodes 
7,8, 14, 15, 16, 1-communicate with 1, while nodes 3, 5, 9, 11, 2-communicate with 1. 
There are no n-communicating nodes for n >3. It is noted that 10 of the original 16 
nodes are included in the tree. (See Fig. 8.) 

The final step is to apply Algorithm A2 to find the minimum rectilinear distances to 
other nodes not on the tree. We use the notation of Algorithm A2: 
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FIG. 7. Example: Two barriers, six origin-destination points. 
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FIG. 8. Tree of vertices communicating with node 1 [F(w(1))]. 
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Step 1: Initialization 


10 closed nodes: {1,3,5,7,8,9, 11, 14, 15, 16}, 


t(1, 1)=0, t(1, 3) = 14, ¢(1, 5) = 13, ¢(1, 7) =7, 1, 8) =7, 
t(1,9) = 17, ¢(1, 11) = 15, (1, 14) =3, 2(1, 15) = 6, ¢(1, 16) =3, 


a, =1,0,=3,03=5,0,=7, a5 =8, We = 9,07 = 11, ag = 14, 
OM =15,a,9= 16, 


m= 10, 
A, (1110) = {w(i) € Wii€é {a, ones aio}, 
H,(1|10) = {2, 4, 6, 10, 12, 13}, 


(1110) = {{1, 9}, {7, (7, 1}, (8, (8, 1], {14, (14, 1]}, 
{15, [15, 1] }, (16, [16, 1] }, {3, (3, 71}, (11, (11, 7]}, 
{S, [5,8] }, (9, [9,8] }}. 


Step 2: First Iteration (See Table III) 


TABLE III. Summary of computations for first iteration. 


2 
@(1, 2|10) 


4 6 10 12 13 
@(1, 4|10) €C1,6|10) €(1, 10/10) (1, 12]10) @c1, 1310) 


Closed \Open 
Node 


3 14 16 28 
5 12 14 

7 14 6 14 
8 10 10 
9 10 18 


é(1, 2|10) = MIN {14, 12, 10, 8} = 8 (hence circled in Table III). 
Similarly, 


é(1, 4110) = 26, €(1, 6/10) = 2, EC, 10|10) = 14, 
(1, 12|10) = 4, (1, 13]10) = 2, 


€o = MIN {€(1,7|10)} = MIN {8, 26, 2, 14, 4, 2} =2, 
7:wQ) EA, (1110) 


Qyo941 = %,, = 6 or 13 (Ties can be broken arbitrarily; 
choose a; = 6), 


t(1,6)=2+ce4=2+9=11. 
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Step 3: Second Iteration 
Using closed node 6. 


@(1, j|11) = @A, j|10) for 7 = 2, 10, 12, 13, 
@(1, 4|11) = 14, 


éo= MIN  {@(1,/11)=MIN {8, 14, 14, 4, 2} =2, 
P:wQMeEre, (li) 


Oy 141 = O12 = 13, 


t(1, 13) =2 + ¢q¢43) =2 + 13 = 15. 


This process continues through four more steps, at which point all nodes are closed 
and the algorithm is terminated. 


V. EXTENSIONS 


We conclude the paper with remarks on three possible extensions: 

(1) The same algorithm can be used to develop optimal paths around smooth 
(differentiable) barriers. Each such barrier provides a node to the associated network 
at every point on the barrier perimeter at which a tangent to the perimeter is parallel 
to one of the two directions of travel.* (The definition of the vertex seeking tree must 
be modified in an obvious way when an eminating ray intersects a barrier.) 

(2) For polygonal barriers, the observation above points to a procedure for reducing 
the number of barrier-generated nodes. Simply eliminate all barrier nodes from which 
only two probes (rather than 4, 3, 1, or 0) can be constructed and modify the defini- 
tion of a vertex seeking tree accordingly. 

(3) For the case in which the entire ng X ng travel distance matrix is desired, the 
ideas of this paper can be used in the Floyd-Warshall algorithm [8], [9]. Two differ- 
ent possibilities come to mind. First, one could find the set of communicating nodes 
directly using the “permissible direction” ideas of Section III and then perform Floyd- 
Warshall iterations only for the unknown distances (having positive penalties). Or, 
second, without any preprocessing, one could perform Floyd-Warshall iterations on 
the entire set of ng X ng penalty distances, immediately recognizing convergence of 
a travel time value whenever the penalty distance at an intermediate iteration is com- 
puted to be zero (implying communication between the corresponding two nodes). 
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